BCIT ~ Mathematics - Examples Fy lnibl 4- t> ^1,^6.4 Page 1 of 1 




BRmSH COLUMBIA 
iNSrmjTE OF TECHNOLOaY 



I APOLrTECHNiC IN^rTUTlON 




BEST AVAILA811E CO! 



5¥ 



Using Transformation Matrices to Change 
from One Coordinate System to Another in 
Robotics 



Background 

In many robotics problems it is useful to define 
more than one coordinate system. For example 
in the picture to the right we have defined three 
coordinate systems. We have attached a 
coordinate system called 6 to the robot's base, 
another coordinate system called H to its hand 
and another called P to the piece that the robot 
must grasp. (By attached we mean that if we 
move the base, the hand or the piece then the 
corresponding coordinate system moves with it.) 
Coordinate system P is useful for locating points 
on the cylinder. Coordinate system B is useful for describing the location of the hand. And coordinate 
system H is useful for measuring distances from the hand. 

Often we know the position and orientation of the piece P relative to the robot's base B but we need 
to know it relative to the hand H so that the hand can be moved correctly to pick up the piece. This 
can be computed if we know the position and orientation of the hand relative to the base. Note that 
orientation as well as position is important if we want the hand to be properly oriented to grasp the 
piece. 

In this background section we will explain how a transformation matrix can be used to describe the 
location and orientation of a second coordinate system with respect to a first coordinate system. 




Consider the following transformation matrix 



T = 



0 


-1 


0 


! -4 


I 


0 


0 


1 5 


0 


0 


1 


1 2 


0 


0 


0 


1 1 



Here is how this transformation matrix can be used to describe the location and orientation of a 
second coordinate system relative to a first coordinate system. We apply the transformation matrix 
to the origin and the endpolnts of the unit vectors of the first coordinate system. This matrix 
multiplication produces the origin and the endpolnts of the unit vectors of the second coordinate 
system: 
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transformation unit unit unit unit unit unit 

matrix origin vector vector vector origin vector vector vector 

i j k i' j- k' 



T • {first coordinate system) = {second coordinate system) 



These two coordinate systems are shown 
in the picture to the right. (The second 
coordinate system is the one with the tick 
marks.) Points can be located relative to 
either coordinate system. For example the 
point P is located at (x' = 2, /' = 1, z' = 
1) in the second coordinate system and at 
(x = -5, / = 7, z = 3) in the first 
coordinate system. 




Probably the quickest way to "design" a transformation matrix like 



T - 



0 


-1 


0 


I -4 
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0 


j 5 
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0 


0 


; 1 



is to notice that the three columns of the 3x3 submatrix give the orientation of the second coordinate 
system in terms of the first like this: 

first column represents: i' = 0 1 + 1 j + 0 k 

second column represents: j' = -li + Oj-hOk 

third column represents: k*= Oi + Oj+lk 

and that the three element vector 
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from the last column gives the position of the origin of the second coordinate system in terms of the 
origin of the first. 



Problem 

A robot's hand is supposed to pick up a part. A coordinate system, P, attached to the part is located 
relative to the "world" coordinate system, W, by the transformation matrix 



Wt - 
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and the robot's base frame, B, is located relative to the world frame by 



Wt 

I r 



1 0 0 

0 1 0 

0 0 1 

0 0 0 



In order to put the hand on the part, we wish to align the hand frame, H and the part frame. What is 
the transformation matrix 

B-r 



(giving the hand frame relative to the robot base frame) that makes this happen? 

Solution 

When the hand frame, H, and the part frame, P, are aligned then 



This is shown in the diagram to the right. 
Now we use the fact that the transformation 
from the world to the base and the 
transformation from the base to the hand can 
be combined into a single transformation 
from the world to the hand, like this: 
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Solving this matrix equation for B gives: 
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or: 
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or finally: 
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As explained in the background, the three columns of the 3x3 submatrix give the orientation of the 
hand coordinate system in terms of the robots base coordinate system and the last column gives the 
origin of the hand coordinate system in terms of the origin of the base coordinate system. 
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